/9‘7 i -/6 z/ni'l 


N94- 26281 


Inertial-Space Disturbance Rejection 
for Space-Based Manipulators 




Kevin Holt and Alan A. Desrochers 
Rensselaer Polytechnic Institute 
Troy, New York 


37 


PR£G®D$N€ PAG£ BLANK NOT FiLMffr 



Disturbance Rejection for Space— Based Manipulators 


K. Holt 

Lockheed Engineering k Sciences Company 


2400 NASA Road 1 
M/S C33 

Houston, TX 77058 


A. A. Desrochers 

Electrical, Computer, k Systems 
Engineering Department 
Rensselaer Polytechnic Institute 
Troy, NY 12180-3590 


ABSTRACT 

This paper describes the implementation of a dis- 
turbance rejection controller for a 6-DOF PUMA ma- 
nipulator mounted on a 3-DOF platform. A control 
algorithm is designed to track the desired position and 
attitude of the end-effector in inertial space, subject 
to unknown disturbances in the platform axes. Exper- 
imental results are presented for step, sinusoidal, and 
random disturbances in the platform rotational axis 
and in the neighborhood of kinematic singularities. 

Robotic manipulators have been proposed as a 
means of reducing the amount of extra vehicular activ- 
ity time required for space station assembly and main- 
tenance. The proposed scenario involves a robotic ma- 
nipulator attached to some mobile platform, such as a 
spacecraft, satellite, or the space station itself. 

Disturbances in the platform position and attitude 
may prevent the manipulator from successfully com- 
pleting the task. This work explores the possibility 
of using the manipulator to compensate for platform 
disturbances. 

The problem of controlling a robotic manipulator 
on a mobile platform has received considerable atten- 
tion in the past few years. Joshi and Desrochers [1] 
designed a nonlinear feedback control law to carry out 
tasks (with respect to the robot base frame) in the 
presence of roll, pitch and yaw disturbances in the plat- 
form axes. Dubowsky, Vance, and Torres [2] proposed 
a time-optimal planning algorithm for a robotic manip- 
ulator mounted on a spacecraft, subject to saturation 
limits in the attitude control reaction jets. Papadopou- 
los and Dubowsky [3] developed a general framework 
for analyzing the control of free-floating space manipu- 
lator systems. Most recently, Torres and Dubowsky [4] 
have presented a technique called the enhanced distur- 
!i? nC ir map * man ipulator trajectories that reduce 
the effect of disturbances in the spacecraft position and 
attitude. 

One common assumption in the literature is that the 
disturbance signal is exactly known. If this is the case, 
then the end-effector location can be calculated with- 
out relying on direct end-point sensing. However, this 
assumption is invalid if there is a significant delay in 
the platform position and attitude measurements, or if 
the kinematics of the platform are not well known, or if 
the platform is a non-rigid structure. In the more likely 
case that only the nominal platform location and up- 
per bound on the disturbance signal are known, direct 


end-point sensing is needed to measure the end-effector 
location. 

1 The Jacobian and Singularities 

The inverse Jacobian is ill-defined for certain manip- 
ulator configurations. This section presents an alter- 
native mapping, called the approximate pseudoinverse 
Jacobian, which is defined for all manipulator configu- 
rations. 

The Jacobian maps differential changes in joint po- 
sition to differential changes in Cartesian position and 
orientation according to the following relationship: 

du = J(q)dq (1) 

where du E 9? 6 is the differential Cartesian displace- 
ment vector (linear and angular), q E is the vector 
of joint positions, dq E 3? n is the vector of differential 
joint displacements, and J E S 6xn is the Jacobian ma- 
trix. 

For the PUMA, the Jacobian matrix is simplest 
when expressed in frame 6: 


V 3l9 = 


(d$ + de)C^e 
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** 5^5 + 06^56 + ^ 75*56 
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0 
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( 2 ) 


The following compact notation will be used to denote 
the matrix 6 J 3| $: 


6 


^3,9 = 


B 0 ' 
D E 


(3) 


where £, D y and E are 3 x 3 submatrices of the Jaco- 
bian. 

The inverse Jacobian, when it exists, can also be 
written in block matrix form 
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5 J — 1 — 
J 3,9 ~ 


B 

D 


0 

E 


M- 


B" 1 0 1 

E- l DB- x E- 1 J 

. ( 4 ) 

The PUMA has three singularities. The first is re- 
ferred to as the Arm Fully Stretched singularity. This 
singularity occurs whenever the arm switches between 
the Ilex and the noflex configurations. 

The second singularity corresponds to the Hand 
Over Head singularity. The Hand Over Head configu- 
ration corresponds to changing between the right and 
left configurations. 

The third singularity is the IVrisf singularity , and 
occurs when the arm switches between the flip and 
noflip configurations. 


2 Approximate Pseudoinverse Jaco- 
bian 

The usual method of dealing with singularities of 
the Jacobian is to avoid them. This approach is not 
applicable to the disturbance rejection problem since a 
sufficiently large disturb ance could force the manipu- 
lator into a singular configuration. Also, the manipu- 
lator must avoid not just singular points , but singular 
regions , since the norm of J -1 becomes very large in 
the neighborhood of a singularity. 

The pseudoinverse Jacobian is often used to over- 
come the difficulty of J being a nonsquare matrix, and 
is defined as 


j 


{ 






m < n 
m = n 
m > n 


( 5 ) 


Clearly, this method of computing J * does not ad- 
dress the issue of singularities since it still relies on 
matrix inversion. A more general approach to com- 
puting the pseudoinverse uses singular value decompo- 
sition. This has one serious drawback, which is the 
high cost of computing the singular value decomposi- 
tion (SVD). The SVD algorithm uses a series of House- 
holder transformations to reduce the input matrix to 
diagonal form. Since this is an 0(N 3 ) operation, find- 
ing the SVD for the 6x6 Jacobian matrix can be too 
costly to implement in real-time. The alternative pre- 
sented in this section is called the approximate pseu- 
doinverse Jacobian, and is denoted by J *. 

The basic idea behind the approximate pseudoin- 
verse is to use the partitioned form of J and perform 
the SVD on the submatrices B and E. This reduces the 
number of computations by a factor of four, since two 
3x3 singular value decompositions is an 0(2(N/2 ) 3 ) 
operation. 

The definition of the approximate pseudoinverse Ja- 
cobian is 

Jt = [ - - jjtDBt ] ( 6 ) 

where B , D, and E are defined as in (3). 

Several properties of the approximate pseudoinverse 
are stated below. 


1. J* = J -1 when J is nonsingular. 

2. J* does not satisfy the Moore-Penrose conditions 
when J is singular. 

3. Let dp, d<f> G ft 3 be the linear and angular com- 
ponents of du, respectively, and let dq\,dq 2 E 3J 3 
be the components of dq. Then, the approximate 
pseudoinverse solution is 

[&H-IU *][*] < 7 > 

If J is singular, the approximate pseudoinverse 
finds the minimum norm solution as if dp and 
d<f> were decoupled ; that is, dq = J*du minimizes 
\\Bdqi - dp|| 2 and || Edq 2 - d^|| 2 . 

3 Behavior Near Singularities 

Figure 1 compares the 2-norm, or the maximum sin- 
gular value, of Jt (solid curve), J * (dashed curve), and 
J -1 (dotted curve) in the vicinity of the Hand Over 
Head singularity. 


1 

8 



Time (tec) 



Figure 1: 2-Norms of (solid curve), J * (dashed 
curve), and J -1 (dotted curve) Near Hand Over Head 
Singularity 

The discontinuities in \\J*\\ 2 and ||J*|| 2 occur when 
the smallest nonzero singular value, cr r , falls below the 
threshold value, Setting <r m i n to a relatively 

small value will shrink the width of the “well” about 
the singular point, thus extending the range over which 
jt = j- 1 and J* = J -1 . The side-effect is that the 
norm will be very large and highly discontinuous near 
the singularity. By the same token, setting (Twin to 
a relatively large value will reduce the discontinuity 
in the norm by increasing the width of the singular 
region. A threshold value of <r mtn = 0.1 was used to 
generate Figure 1. 
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4 Bound on Approximation Error 

The pseudoinverse and approximate pseudoinverse 
Jacobians are identical only when J is nonsingular. In 
order to characterize the difference in behavior at a 
singularity, some measure of the approximation error 
is needed. A reasonable way to measure the approxi- 
mation error is to see “how close” J* is to being a true 
generalized inverse using the following norm: 




Consider the matrix 


(8) 

Table 1: Computation Times for an d 

Subtracting J yields *^1 ,e 
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( 9 ) 


When both B and E are singular, the approximation 
error is bounded as follows: 
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( 10 ) 


< imi 2 

If B is nonsingular, a less conservative upper bound 
can be found: 


||jj»j-7|| 2 


7 0 

0 I -EE' 


< ll^lla 


0 0 

0 E 

J 2 

(ii) 


Likewise, when E is nonsingular the upper bound re- 
duces to 


-•'i, = 

< 


fB O' 

1 - B'B 0 1 

[ 0 0 

0 1 J 


H L J L ~ * JII2 

l|S|| 2 (12) 


Finally, if both B and E are nonsingular, the approx- 
imate pseudoinverse is identical to the pseudoinverse: 


l J</ * 7 - / llj = ° (13) 


5 Computation Time 

Table 1 compares the computation times of the the 
inverse, pseudoinverse, and approximate pseudoinverse 
Jacobians for each coordinate frame. As predicted, the 
approximate pseudoinverse is about four times faster 
to compute than the pseudoinverse. 

The inverse, pseudoinverse, and approximate pseu- 
doinverse Jacobian solutions were implemented in the 
C programming language using the GNU 1 gcc Version 
2.2.2 compiler. The data in Table 1 was collected by 
timing the software on a Motorola MVME 147SA-2 
Single Board Computer. 

6 A Kinematic Control Law for Distur- 
bance Rejection 

Consider a 6-DOF PUMA manipulator mounted on 
a 3-DOF platform. The goal is to maintain the desired 
position and attitude of the end-effector with respect 
to the inertial reference frame (frame 0), subject to 
arbitrary disturbances in the platform axes. The fol- 
lowing information is assumed to be available: 

1. 9 E 8i 6 , the PUMA joint positions 

2. rj 0 E Sfi 3 , the nominal platform joint positions 

3. 6 E 3ft 3 , the maximum deviations from the nomi- 
nal platform joint positions 

4. °uo,« € Si 6 , the inertial end-effector location 

Two factors contribute to the motion of the end- 
effector: the differential displacement of the PUMA 
joints, which can be measured, and the differential dis- 
placement of the platform joints, which is unknown. 
Let 6 denote the disturbance signal and let dv be the 
component of the end-effector motion caused by the 

Copyright (C) 1989, 1991 Free Software Foundation, 
Inc., 675 Mass Ave, Cambridge, MA. 



differential displacement of the platform joints. Then, 
the differential end-effector displacement can be writ- 
ten as 

°dtio >E = °*/3, £?(*?<> "H Q)dO + dv 

= 3 R(rj 0 + 6) 3 Ja, E (9)d$ + dv (14) 

Note that coordinate frame transformations have been 
applied to isolate the dependence of the PUMA Jaco- 
bian on the platform joint positions. 

A discrete-time model of the system will now be 
derived by approximating the differential quantities 
in (14) with displacements. The underlying assump- 
tion here is that tie sampling period, AT, is suffi- 
ciently mall (Le., the sampling rate is much higher 
than the bandwidth of the system). 

Define Au* as A where the sub- 
script k denotes the kth sample step. In the limit as 
AT goes to icto, the displacement Ati* equals the dif- 
ferential du: 

lim Aujfc = du (15) 

Similarly, A 0* — ► dO and A Vk — * dv as AT — ► 0. 
Therefore, the discrete-time approximation is 

du « Au* = ut — tijb_i 

dO « A0* — 9 k — i 

dv « At;jk sr Vk — Vk~i (16) 

and the discrete version of (14) is 

°«t- °«i_i = ImVo + StfJzAWMk + Avk (17) 

where the subscripts denoting the reference and veloc- 
ity frames of du have been dropped to avoid confusion 
with the time index. 

Let u tid be the desired position and orientation of 
the end-effector along some specified trajectory. The 
control objective is to drive the end-effector to this 
position and orientation: 

°u* — ► °ti<* as k — ► oo (18) 

Ideally, the control objective could be achieved in min- 
imum time by computing the PUMA joint displace- 
ments A Oa needed to cancel out the inertial-space er- 
ror. However, exact cancellation would require com- 
plete knowledge of the disturbance signal. The next 
best solution then is to compute a A 0& which approx- 
imately cancels out the inertial-space error. With this 
goal in mind, the proposed control law is 

= 3 Jl E (0k)ln.(v>)K e (°U4 - °u k ) (19) 

where K c E 3ft 6 x 6 is a matrix of control gains. Equa- 
tion (19) will be referred to as the J* control law in 
the sequel. 


A simple expression for the closed-loop system can 
be derived by assuming that there is a one period delay 
in the control actuation: 

A0* +1 = AO* (20) 

°«* - %_! = §R(»j 0 + 6 k ) 3 J 3iB (0 k ) 

( 21 ) 

3 4, B (^-i)?R(»?o)^( 0 Ud - V-i) + At* 

In order to simplify this expression, define the quantity 

M M _j £ 3R(»?o + ^) 3 J3 lE (^) 3 4 B ( (, ‘-l)oR-(»7o)^ 

( 22 ) 

Rewriting (21) in terms of Mk t k-u it is easy to see 
that the closed-loop system is linear with time- varying 
coefficients; 

V = (J - M k , t - i)°u t _i + M m _ x 0 u d + At* (23) 

A block diagram of the closed-loop system is shown in 
Figure 2. 



Figure 2: Block Diagram of Closed- Loop System 

6,1 Design Parameters 

The selection of the control gain is greatly simpli- 
fied by restricting K c to be a scalar times the identity 
matrix: 

K e = Jb c 7, 0 < k e < 2 (24) 

The parameter k c controls the spectral radius of Aft. 
For example, if k c — 0.5, then the eigenvalues of M* 
will lie on a circle of radius 0.5 in the A-plane (or at 
zero, if J is singular). 

It is straightforward to choose a stable k c if 6 is 
known a priori . (Recall that b is the vector of maxi- 
mum deviations in the platform joint positions.) Let A 


4l 




denote the spectrum of the matrix 3 R (r ) 0 + $) 

By invoking the slowly time- varying condition, a can 
be approximated as follows: 

a « sup arg(A) (25) 


and k c is calculated as 


c Vtan 2 a + 1 


(26) 


The selection of a m i n is essentially a trade-off be- 
tween tracking accuracy and the norm of the control 
signal. The selection of cr min should be based on the 
desired upper bound on the norm of A 6 d) which in 
turn is dictated by the saturation limits of the joint- 
level controller. 




7 Experimental Results 

Three sets of experiments focused on the time re- 
sponse of the closed-loop system for step disturbances 
in the platform joints, sinusoidal disturbances in the 
platform joints, and random disturbances in the plat- 
form joints. Here we present only the results for the 
step disturbance. 

This section analyzes the time response of the 
closed-loop system for 10° and 30° step disturbances 
in the platform rotation. For each case, the control 
gain K c was set to identity. 

7.1 10° Step Disturbance 

Figure 3 shows the inertial-space errors errors when 
a 10° step disturbance is applied to the platform rota- 
tional joint. The linear (X, Y , and Z) components of 
the error are shown in the upper plot and the orienta- 
tion error in the lower plot. The components of A 64 , 
the control vector, are plotted in Figure 4. 


Figure 3: Position Error ( X - solid curve; Y - dashed 
curve; Z - dotted curve) and Orientation Error for 10° 
Step Disturbance in Platform Rotation 



Figure 4: Control Signals (A0d(l)i A^(4) - solid 

curves; A0 d (2), A 0 d (5) - dashed curves; A0<*(3), 
A0d(6) - dotted curves) for 10° Step Disturbance in 


Platform Rotation 



Maximum Overshoot 

4% Settling Time 

X 

1.527 xl0 +u cm 

1.54 s 

Y 

3.825 xl0 +u cm 

0.84 s 

Z 

6.366 xlO -1 cm 

1.70 s 

<t>* 

3.503 xl0 +u deg 

1.00 s 


Table 2: Maximum Overshoot and 4% Settling Time 
for 10° Step Disturbance in Platform Rotation 

Table 2 lists the maximum overshoot and 4% set- 
tling time for the X, Y, Z, and orientation errors. The 
4% settling time refers to the time required for the er- 
ror to enter and remain within ±€ of zero, where e is 
4% of the peak absolute error. 

7.2 30° Step Disturbance 

The inertial-space errors and control signals for the 
30° case are shown in Figures 5 and 6. The maxi- 
mum overshoot and settling time for each coordinate 
are displayed in Table 3. 



Figure 5: Position Error ( X - solid curve; Y - dashed 
curve; Z - dotted curve) and Orientation Error for 30° 
Step Disturbance in Platform Rotation 






Control Signal (deg) 10*0) 




6: Control Signals (A0 d (l), A0d(4) - solid 
A0 d (2), A0 d (5) - dashed curves; A0 d (3), 
A0<j(6) - dotted curves) for 30° Step Disturbance in 


Figure 

curves; 


Platform Rotation 


8 Behavior Near Singularities 

Figure 7 shows the vector of open-loop control sig- 
nals near the Arm Fully Stretched singularity. The 
minimum singular value parameter, <r min , was set to 

0.1. At this value of the control in the direc- 
tion of the workspace boundary becomes very weak 
approximately 30° from the singular point. This pre- 
vents the end-effector from getting too close to the 
workspace boundary. Consequently, the manipulator 
will not switch between the flex and noflex configu- 
rations while the J * controller is running. 

If the parameter <r min is sufficiently small, however, 
the width of the singular region will be reduced to 
the point where the control signal for joint 6 (A0<*(3)) 
could drive the arm through the singularity. This 
may lead to an undesirable “chattering” behavior, in 
which the arm rapidly oscillates between the flex and 
noflex configurations. 

9 Summary 

Several important conclusions can be drawn from 
the experimental results. 

1. The relative stability of the closed-loop system 
is a function of the amplitude of the disturbance 
signal. 

2. The relative performance of the controller is a 
function of the frequency of the disturbance sig- 
nal. 



Maximum Overshoot j 

4% Settling Time 

X 

1.737 xl0 +1 cm 

1.97 s 

Y 

1.706 xl0 +1 cm 

2.43 s 

Z 

1.253 xl0 +1 cm 

1.66 s 

4>e 

2.055 xl0 +1 deg 

2.08 s 


Table 3: Maximum Overshoot and 4% Settling Time 
for 30° Step Disturbance in Platform Rotation 



Figure 7: Behavior of l/det(J) and Open-Loop Con- 
trol Signals (A0<*(1), A0<*(4) - solid curves; A0<*(2), 
A0<*(5) - dashed curves; A0<*(3), A0<*(6) - dotted 
curves) Near Arm Fully Stretched Singularity 


In other words, the J * controller is like a high-pass 
filter; the lowest frequency components of the distur- 
bance signal are attenuated the most. 

3. The control in certain directions becomes very 
weak near singularities. 

This implies that there may be an unavoidable tracking 
error in the “forbidden” directions when the arm is at 
or near a singularity. 
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